package spectrum;

import edu.wpi.first.wpilibj.*;
import utilities.*;

/**
 *
 * @author 
 */
public class Disabled {

    public static void robotInit() {
        Utils.debugPrintln("Debug ENABLED");
        Utils.errorPrintln("Error ENABLED");

    }

    public static void init() {
        HW.Jag1 = HW.getJaguar(1);
        HW.Jag2 = HW.getJaguar(2);
        HW.Jag3 = HW.getJaguar(3);
        HW.Jag4 = HW.getJaguar(4);
        
        HW.SpectrumDrive = new RobotDrive(HW.Jag1,HW.Jag3,HW.Jag2,HW.Jag4);
        HW.SpectrumDrive.setInvertedMotor(RobotDrive.MotorType.kFrontLeft, true);
        HW.SpectrumDrive.setInvertedMotor(RobotDrive.MotorType.kRearLeft, true);
        System.out.println("RobotInit() completed.\n");
    }

    public static void periodic() {
    }

    public static void continuous() {
    }

}
